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Abstract — This  paper  focuses  on  the  problem  of  developing 
control  laws  to  solve  the  Time-Coordinated  3D  Path-Following 
task  for  multiple  Quadrotor  UAVs  in  the  presence  of  time-varying 
communication  networks  and  spatial  and  temporal  constraints. 
The  objective  is  to  enable  n  Quadrotors  to  track  predefined 
spatial  paths  (parameterized  by  virtual  time)  while  coordinating 
to  achieve  synchronization  in  time.  One  scenario  is  a  symmetric 
exchange  of  position  by  four  Quadrotors  initially  positioned  in 
four  corners  of  a  square  room.  When  the  mission  starts,  every 
quadrotor  is  required  to  execute  collision  free  maneuvers  and 
arrive  at  the  opposite  corner  at  the  same  desired  instant  of  time. 
In  this  paper,  the  path-following  control  algorithm  is  derived 
using  the  Special  Orthogonal  group  theory  (SO(3)),  thus  avoiding 
singularities  that  arise  when  dealing  with  local  parameterizations 
of  the  vehicle’s  attitude.  The  coordination  task  is  solved  by 
adjusting  the  second  derivative  of  the  virtual  time  along  the 
spatial  paths. 

I.  Introduction 

Avoiding  harm’s  ways  requires  the  employment  of  intel¬ 
ligent  autonomous  vehicles.  Combined  with  recent  advances 
in  miniature  technology  brings  a  global  spotlight  on  the 
development  of  Unmanned  Aerial  Vehicles  (UAVs).  Currently, 
the  use  of  UAVs  plays  a  crucial  role  in  preventing  exposure  of 
human  beings  to  uncertain  and  hostile  environments,  therefore 
avoiding  any  danger  to  lives  of  operators.  For  instance,  after 
being  struck  by  the  biggest  recorded  earthquake  and  a  dev¬ 
astating  tsunami,  Japan  has  been  fighting  a  potential  nuclear 
catastrophe  deploying  UAVs  in  situations  where  the  presence 
of  human  operators  was  hazardous. 

From  a  design  point  of  view,  and  with  a  slight  abuse  of 
terminology,  UAVs  can  be  classified  in  two  main  categories: 
fixed-wings  and  rotatory-wings.  Compared  to  the  fixed-wings, 
that  cannot  freely  move  in  any  direction  (rotate)  or  hold 
a  constant  position,  rotorcrafts  can  be  deployed  in  a  much 
wider  variety  of  scenarios.  Among  the  rotatory-wings  air¬ 
craft,  Quadrotors  play  an  important  role  in  research  areas  as 
prototypes  for  real  life  missions,  including  monitoring  and 
exploration  of  small  area. 

A  Quadrotor  consists  of  four  blades,  whose  motion  control 
is  achieved  by  adjusting  the  rotation  rate  of  one  or  more 
rotor  discs.  Control  of  Quadrotors  is  quite  challenging  and 
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has  been  addressed  in  many  recent  publications.  To  mention 
a  few,  in  [1]  and  [2]  a  stabilization  and  control  algorithm 
is  developed  using  Lyapunov  stability  theory.  In  [3]  and  [4] 
PD2  and  PID  architectures  are  compared  with  LQR  based 
control  theory.  Backstepping  control  is  proposed  in  [5],  while 
in  [6]  and  [7]  a  visual  based  feedback  control  law  is  presented 
using  camera  measurements  for  pose  estimation.  Fuzzy  logic 
control  techniques  are  proposed  in  [8].  Intelligent  control, 
based  on  neural  networks,  is  introduced  in  [9]  to  achieve 
vertical  take  off  and  landing.  Finally,  integral  sliding  mode 
and  reinforcement  learning  control  are  presented  in  [10]  as 
solutions  for  accommodating  the  nonlinear  disturbances  for 
outdoor  altitude  control.  The  PF  (path  following)  control  law 
presented  in  this  paper  is  motivated  by  [11],  where  a  Lyapunov 
based  control  is  formulated  using  the  Special  Orthogonal 
group  (S0(3))  theory,  leading  to  a  simple  and  singularity  free 
solution  for  the  trajectory  tracking  problem.  A  similar  idea  has 
already  been  adopted  by  the  authors  in  [12],  where  a  solution 
for  the  3D  PF  problem  for  fixed-wings  UAVs  was  presented. 
Furthermore,  motivated  by  more  challenging  scenarios,  the 
same  algorithm  was  employed  in  [13],  where  multiple  fixed- 
wings  UAVs  were  asked  to  coordinate  while  following  their 
desired  paths. 

Cooperation  between  multiple  unmanned  vehicles  has  re¬ 
ceived  significant  attention  of  control  community  in  recent 
years.  Relevant  work  includes  spacecraft  formation  flying 
[14],  UAV  control  [15],  [16],  coordinated  control  of  land 
robots  [17],  and  control  of  multiple  autonomous  underwater 
vehicles  [18],  [19].  However,  much  work  remains  to  be 
done  to  overcome  numerous  critical  constraints.  For  example 
one  of  the  crucial  problems  is  the  presence  of  time-varying 
communication  networks  that  arise  due  to  temporary  loss  of 
communication  links  and  switching  communication  topologies 
[20],  [21], 

Motivated  by  these  challenges,  the  objective  of  the  paper 
is  to  enable  a  set  of  Quadrotor  UAVs  to  converge  and  follow 
a  set  of  desired  paths  under  stringent  temporal  constraints. 
A  typical  example  is  captured  in  Figure  1,  where  a  set  of 
vehicles,  starting  from  random  initial  positions,  must  arrive  at 
their  final  positions  at  the  same  time  tf,  and  hold  a  specified 
formation.  The  solution  proposed  consists  of  two  basic  steps: 
first,  a  PF  control  law  is  designed  to  drive  each  vehicle  on 
a  predefined  spatial  path  To  achieve  the  objective. 


it  is  assumed  that  all  the  Quadrotors  have  the  same  mass), 
fi(t)  is  the  total  thrust  of  the  four  propellers,  R,  =  RJB  the 
rotation  matrix  from  the  body  frame  to  the  inertial  frame,  and 
Ui  =  \Pi(t) >  Qi{t),  ri(t)}  the  angular  velocity  of  the  vehicle 
expressed  in  Bi.  Then,  we  can  define  the  position  error  vector 
eXti  £  R3  as 

&x,i{B)  —  •X'd.jiiSYi)  •t'i(f)  (2) 


and  the  velocity  error  vector  ev  i  £  R3  as 


&v,i  (f  ) 


dxd,i{"ii) 

dli 


Xi{t)  . 


(3) 


Assume  that  the  position  error  and  the  desired  velocity  and 
acceleration  are  bounded,  that  is: 


Fig.  1:  A  typical  example  of  a  fleet  of  UAVs  coordinating 
along  predefined  paths 


the  PF  algorithm  produces  angular  rates  and  thrust  command, 
which  are  sent  to  an  onboard  Autopilot  (AP);  second,  syn¬ 
chronization  is  achieved  by  adjusting  the  accelerations,  thus 
obtaining,  indirectly,  vehicle  coordination.  Figure  2  captures 
the  key  concept  described  above. 

This  paper  is  organized  as  follows.  Section  II  defines  the  PF 
problem  for  a  single  Quadrotor  UAV.  Section  III  formulates 
the  Time-Coordination  (TC)  problem  for  a  fleet  of  vehicles.  In 
Section  IV  the  two  problems  developed  in  the  previous  Sec¬ 
tions  are  combined,  giving  a  definition  of  Time-Coordinated 
3D  Path-Following  (TCPF).  Section  V  addresses  the  stability 
and  convergence  properties  of  the  TCPF  problem.  Section  VI 
presents  simulation  results.  Finally,  Section  VII  summarizes 
the  key  results  and  presents  the  main  conclusions. 

II.  3D  Path-Following 
A.  Problem  Formulation 

The  basic  idea  pursued  in  this  paper  is  to  reparameterize 
an  existing  trajectory  tracking  controller  as  a  path  follow¬ 
ing  controller.  In  this  paper  we  adopt  with  minor  changes 
the  trajectory  tracking  controller  developed  in  [11]  .  Thus, 
for  completeness  of  presentation,  we  follow  the  notation 
introduced  in  [11]  and  next  briefly  summarize  the  trajectory 
tracking  controller  development  reported  there  and  rewrite  it 
as  a  path  following  controller. 

Let  X  =[e i ,  e2  ,  e3]T  and  B,  =  [61;l ,  62ji ,  63ji]T  be  two 
coordinate  frames  representing  the  inertial  frame  and  the  body 
frame  attached  to  the  z-th  Quadrotor.  Let  also  Xd,i{li)  be  a 
desired  path  parameterized  by  7 i.  The  choice  of  the  parameter 
7 i  is  discussed  later. 

Let  the  motion  of  the  Quadrotor  be  governed  by 

{Xi  =  Vi 

mVi  =  fib3i  —  mge?,  (1) 

Ri  =  RiS(uji) , 

where  Xi(t)  and  Vi(t)  are  the  position  and  velocity  of  the 
z-th  Quadrotor,  m  is  its  mass  (with  no  loss  of  generality. 


dxd 

dji 

d2xd ,, 

dl 2 

for  some  61^,62,2  >  0,  and  let 


X  &x,i  max 

(4) 

<  bl,i 

(5) 

<  &2,i 

(6) 

max  —  ^  ^  &x,i  max  5 
2—1 


n 


n 


h  -  ^2  b2,i . 

2  —  0  2—0 

Following  [11],  we  now  introduce  an  auxiliary  frame  1), , 
which  is  used  to  shape  the  approach  to  the  path  as  a  function 
of  the  error  components  eXt,  and  e,..,;.  Let  the  rotation  matrix 
from  the  frame  T),  to  the  inertial  frame  X  be 


Rbi  =  Rc,i  =  [blD,i,  &3 D,i  X  b±D,i,  bzD,i] 


where 


ltx&x,i  "P  kyt'Vd  “P  tjltje 3  T  m  ft  ‘2 
b'MKi  -  - - - - : - : - (7) 


II  kxex>i  +  kveVti  +  mge3  +  m-^ f 


and  h  \  /)  ,  is  chosen  in  order  to  be  orthonormal  to  h^D  ,  .  The 
vector  b3D,;  defines  the  desired  orientation  of  the  z-axis  of  the 
Quadrotor  i  (63jQ. 

Assume 

d2xd,i , 
dl2 

and 

d-Xdi . 


1 1  kx^x,i  “P  kv^v.i  “P  Ttlge-s  T  Ul  ^  ^  \  |  7^  b  ; 


|  mgej,  +  m- 


H 


<  Bi , 


(8) 

(9) 


for  any  Bi  >  0. 

Let  Ri  be  the  rotation  matrix  from  B,  to  'D, ,  that  is 


Then, 


£>.  _  _  pT  P. 

2Tj  —  il^  .  —  T  j ilj  . 


Ri  =  RiS(tii) 


Fig.  2:  TCPF  Control  Scheme 


where 


and 


OJi  =  OJ 


Bi  _ 

BiDi  ~ 


Pi 

Qi 

n 


-  R  U 


T,  ,Di 


Dil  > 


=  RliRc 


(10) 


Note  that,  if  we  have  /?,  =  I,  the  frame  B,  overlaps  the 
desired  frame  T>i. 

Then,  the  objective  of  the  controller  developed  is  to  drive 
the  position  error  eXji  and  the  velocity  error  ev/l  to  zero,  and 
the  rotation  matrix  R  to  the  identity. 

Consider  the  real-valued  function  on  SO(3): 

*{R)=l-tr{I-R),  (11) 

and  its  time  derivative 

^f(R)  =  ~^tr(RS(u>i)). 

Finally,  let  the  attitude  error  vector  be 

eR,i  =  \J*(Ri)(2~mi))  =  \vec(R i  -  Rj )  •  (12) 

Using  properties  of  the  SO(3)  group  [22],  we  get: 

'b(Ri)  =  \eR,i'Ui-  (13) 

Therefore,  the  dynamic  of  the  PF  errors  can  be  summarized 

in  the  following  system  of  equations: 


&x,i  — 


TTlCy^i 

*{Ri) 


dxd,i  • 

S±-l i  -  Xi 
a2 

O  Xd.i  ■ 

= 

-  1P~  '  ~ 
2  cR,i 


■  Wi  • 


fib3,i  +  mge3 


Using  the  above  notation,  we  now  define  the  PF  for  a  single 
vehicle. 

Definition  1:  Path-Following  Problem  (PF):  For  a  given 
i- th  Quadrotor  UAV,  and  for  a  given  path  2^,(7),  design 
feedback  control  laws  for  the  total  thrust  /,(t),  the  roll 
rate  Pi(t),  pitch  rate  qt{t)  and  yaw  rate  77(f)  such  that  the 
generalized  PF  error  vector  Xppt  =  [exg  ,  evg  ,  eg  J,  with  the 
dynamic  described  in  (14),  converges  to  a  neighborhood  of  the 
origin,  for  any  physically  feasible  temporal  speed  assignment. 

B.  Quadrotor  with  autopilot 

A  typical  Quadrotor  is  equipped  with  an  onboard  AP,  that 
stabilizes  the  body  and  tracks  the  thrust  and  angular  velocities 
reference  commands.  Therefore,  it  is  necessary  to  take  into 
account  possible  limits  on  the  performance  of  the  AP  inner- 
loop.  Thus,  we  assume  that  : 


I pc,i{t)  -pi(t)  1  <  5p>i 

(15) 

O 

1 

IA 

•p 

(16) 

c 

KD 

VI 

HO 

1 

<lT 

(17) 

\fc,i(t)  -  fi(t)  |  <  5fg 

(18) 

where  pc,i(t J ,  qc,i(t) ,  rc>,;(f) ,  fc,i(t)  are  the  commanded  in¬ 
puts  from  the  controller  to  the  AP,  Pi(t) ,  ,  77(f) ,  /,(f) 

are  the  actual  commanded  values  from  the  inner  loop  architec¬ 
ture  to  the  vehicle,  and  6pj,  8qg,  5rj,  8ftl  are  the  bounds  which 
characterize  the  tracking  performance  of  the  AP.  Finally,  let 

n 

$q  =  ^  Sq,i  , 
i=  1 
n 

sf’*  ■ 

i—  1 


be 


SP,i  > 

i= 1 

n 


(14) 


III.  Time-Coordination  of  a  fleet  of  Quadrotor 
UAVs:  Problem  Formulation 

We  now  address  the  problem  of  the  TC  of  a  fleet  of  n 
Quadrotor  UAVs. 

As  described  in  the  Section  II,  the  desired  path  of  every 
vehicle  is  parameterized  by  some  variable  7,,  with  i  = 
1 ,  ... ,  n.  The  choice  of  the  parameter  7 j  is  such  that,  if 
7 i  —  7 j  =  0  Vi,  j,  i  j  and  7,;  =  1  at  some  final  time 
t f  then  all  the  vehicles  arived  at  their  destinations  at  the  same 
time. 

To  achieve  time  synchronization  the  parameters  7 j  have  to 
be  exchanged  among  the  Quadrotors  over  a  communication 
network.  Using  tools  from  graph  theory  we  model  the  infor¬ 
mation  exchanged  over  the  time-varying  network  as  well  as 
the  constraints  imposed  by  the  communication  topology.  We 
start  by  assuming  that  the  i-th  UAV  communicates  only  with 
a  neighboring  set  of  vehicles,  denoted  by  (/.;•  We  also  assume 
that  the  communication  between  two  UAVs  is  bidirectional 
with  no  delays.  The  reader  is  referred  to  [23]  for  key  concepts 
and  details  on  algebraic  graph  theory. 

Following  the  notation  used  in  [13],  we  now  let  L(t)  £ 
Rnx"  be  the  Laplacian  of  the  graph  F(f).  Let  Q  £  K(n“1)xn 
be  a  matrix  such  that  Qln  =  0,  QQT  =  In-\  and  L(t)  = 
QL(t)QT ,  where  L  £  ]R(n_1)x(n_1)  with  the  spectrum  equal 
to  the  spectrum  of  L{t)  without  the  eigenvalue  Ai  =  0. 
Finally,  we  let  L(t)  satisfy  the  persistency  of  excitation  (PE) 
assumption: 

t+T 

J  L(t)<It  >  flln-l  ■  (19) 

t 

Given  the  above  notation,  we  now  let 

m  =  Qi(t)  (20) 

where  f(i)  =  [£i(t),  62(f),  £n-i(t)]  G  R”-1  and  7 (t)  = 

[71(f),  72(f), ...,  7„(f)]  £  Rn.  From  the  definition  of  Q,  if 
£(f)  =  0”,  then  7,  —  jj  =  0  Vi,  j  =  1 ,  ... ,  n. 

Let  also 

(21) 

where  z(t)  =  [21(f),  22(f), 2n(f)]  G  K".  Note  that  if  2*  =  0 
then  7j  =  t. 

With  the  above  notation,  the  coordination  problem  can  now 
be  defined. 

Definition  2:  Time  Coordination  Problem  (TC):  Given 
a  set  of  n  3D  desired  trajectories  2^7(7*),  design  feedback 
control  law  for  7,  such  that  the  vectors  £  and  2  defined  in 
(20)  and  (21),  converge  exponentially  to  a  neighborhood  of 
the  origin  Vi  =  1 ,  ... ,  n. 

IV.  Time-Coordinated  3D  Path-Following: 

Problem  Formulation 

In  the  previous  sections  we  formulated  the  PF  problem  for  a 
single  vehicle,  and  the  TC  problem  for  a  fleet  of  n  Quadrotor 
UAVs.  In  this  section  we  combine  these  two  by  defining  the 


TCPF  problem.  Consider  the  dynamic  of  the  PF  error  variables 
in  (14).  Using  the  variable  2  defined  in  (21),  we  get 


_  dxd,i  „  | 

&x,i  —  q, yi  %i  1  &v,i 

d2Xd  i  ,  d2Xd  i  nT  ,  -» 

mev,i  =  m-g^-Zi  +  m-Q, -  jb3ti  +  mge3 
*&)  =  \eR,i  ’  • 


(22) 


Vi  =  1 ,  ... ,  n. 

Let  ex  ,  ev  ,  ep,  and  d/(i?)  be 


&X  — 

[eh  , 

1  ex,2  5  •* 

•  >  ex,n]T  G  R3"Xl  , 

(23) 

Cy  - 

[eh  ■ 

PT 

,  t^v  2  ?  •• 

■  )  eJ,n]T  G  K3™Xl  , 

(24) 

eR 

[4,t  . 

eT 

1  CR, 2  >  '■ 

(25) 

and 

n 

^)^t(K,)eR,  (26) 

i= 1 

and  let  xpf  =  [ej  ,  ej  ,  epT.  Recall  also  the  TC  error 
variables  defined  in  (20)  and  (21).  Then,  the  main  objective 
of  this  paper  can  be  stated  as  follows: 

Definition  3:  Time  Coordinated  3D  Path  Following 
Problem  (TCPF):  Given  a  fleet  of  n  UAVs,  a  communication 
network  satisfying  (19)  and  a  set  of  n  3D  desired  trajectories 
>Lj,i(7i),  design  feedback  control  laws  for  the  total  thrust  /)(f) 
and  for  roll  rate  Pi(t),  pitch  rate  q,;(f)  and  yaw  rate  r,(f) 
such  that  the  PF  errors,  with  the  dynamic  described  in  (22) 
,  converge  to  a  neighborhood  of  the  origin  Vi  =  1 ,  ... ,  n. 
Also,  design  a  feedback  control  law  for  7,  such  that  the  TC 
errors  defined  in  (20)  and  (21)  converge  to  zero. 


V.  Time-Coordinated  3D  Path-Following:  Main 
Result 

First,  let  the  total  thrust  of  the  i-th  vehicle  be  governed  by 

(  d2Xd  i  \  T  -* 

fi  =  [kxex,i  +  kveVti  +  mge3  +  m  b3,i  ■  (27) 

In  addition,  let  the  angular  rates  of  the  i-th  quadrotor  be 


—  RJujd1_j  2 


(28) 


Finally,  let 

7  =  2  =  —  bz  —  aLj  — 


^1  1^21,1 

^2 

_ 

^1,2^*, 2 
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&2,2ev,2 
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_2  n^v,n_ 

(29) 


where 
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dll  ) 


Remark  1:  Note,  we  modified  the  controller  used  in  [11] 
in  two  important  ways.  First,  we  reparametrized  it  as  path 
following  controller  and  second  we  modified  it  to  use  angular 
rates  and  thrust  as  control  inputs  to  be  followed  by  an  existing 
inner-loop  autopilot.  In  turn,  this  compels  us  to  consider  the 
underlying  performance  limitations  due  to  the  constrains  of 
the  inner-loop  controller. 

Then,  the  Lemma  below  states  one  of  the  main  results  of 
this  paper: 

Lemma  1:  TCPF  with  ideal  inner-loop  tracking  perfor¬ 
mance:  Let  the  total  thrust  and  the  angular  velocities  of  each 
quadrotor  be  governed  by  (27)  and  (28).  Let  also  7,  be  driven 
by  (29).  Then,  there  exist  kx  ,  kv  ,  ,  Ci ,  a  and  b  such  that 

the  error  vector 

*  =  [el ,  eTv  ,  el ,  ?T  ,  *T]T  (30) 


VI.  Simulation  Results 

In  this  Section,  simulation  results  are  presented.  The  sce¬ 
nario  involves  four  vehicles.  The  UAVs  are  asked  to  follow 
four  intersecting  paths.  The  geometry  of  the  paths,  and  the 
constant  desired  speed  profiles,  are  chosen  to  ensure  collision 
avoidance.  Figure  3  illustrates  the  above  scenario.  LAV  4  starts 
its  mission  far  away  from  the  desired  initial  position.  This 
initial  PF  error  implies  an  initial  divergence  of  74  from  the 
desired  value.  However,  as  shown  in  Figure  4  and  5,  despite 
this  initial  error,  the  control  algorithm  ensures  the  convergence 
to  the  origin  of  the  coordination  states  and  collision  free 
exchange  of  positions. 

Finally,  Figure  6  illustrates  the  performance  of  the  PF 
control  algorithm. 

VII.  Conclusion 


converges  exponentially  to  zero  with  rate  of  convergence 

A  =  min(ApF  ,  Arc) ,  (31) 

for  any 

A pF  >  0  (32) 

and  with 

XtC  <  T(l+n2T)2  (33) 

and  corresponding  domain  of  attraction 

=  {(e*  ,e^)  I  y(R)  <  c2  <  1 , 1 1  Ccc  1 1  <  exmaxj  .  (34) 

A  proof  of  this  result  is  omitted  due  to  the  page  limitation; 
however  its  brief  outline  is  given  in  Appendix  A. 

As  our  last  step,  we  consider  the  case  of  non  perfect  inner- 
loop  discussed  in  Section  II-B.  The  main  result  of  our  paper 
follows. 

Lemma  2:  TCPF  with  non  perfect  inner-loop  tracking 
performance:  Let  the  total  thrust  and  the  angular  velocities 
of  each  quadrotor  be  governed  by  (27)  and  (28).  Let  also  Abe 
driven  by  (29).  Let  6  be  a  positive  constant  such  that 

0  <  9  <  A  ,  (35) 


where  A  was  defined  in  (31).  Let  also  the  performance  bounds 
defined  in  Section  II-B,  satisfy 

€-xmaxkxTTlQ 

7,  <  - ,  (36) 

and 

7c  =  y^+7g2+7r2<  2^-  <37> 

Then,  there  exist  kx  ,  kv  ,  k^  ,  C\  ,  a  and  b  such  that,  for  any 
initial  state  x(0)  €  Llc  there  is  a  time  2],  >  0  such  that  the 
bound  in  (38)  holds  V  0  <  t  <  Tt,  and  the  bound  in  (39) 
holds  V  t  >  Tf,. 

The  outline  of  the  proof  is  given  in  Appendix  B. 

Remark  2:  Note,  as  7P,7g,  7r  and  7 7  go  to  zero,  we 
recover  ideal  performance  shown  in  Lemma  1 


This  paper  considered  the  problem  of  steering  a  fleet  of 
Quadrotor  UAVs  along  the  predefined  spatial  paths,  while 
coordinating  with  each  other,  according  to  the  mission  require¬ 
ments.  Cooperative  control  is  achieved  in  the  presence  of  time- 
varying  communication  networks,  and  stringent  temporal  con¬ 
straints.  The  constraints  include  collision-free  maneuver  and 
simultaneous  arrival  at  the  desired  locations.  The  PF  problem 
is  solved  using  the  SO (3)  theory,  which  avoids  the  singularities 
that  arise  when  using  local  parametrization  of  the  vehicle’s 
attitude.  Angular  velocities  and  total  thrust  are  used  to  drive 
the  Quadrotors  to  the  desired  positions.  Non-ideal  inner-loop 
tracking  performance  is  also  considered.  Coordination  between 
the  UAVs  is  achieved  by  adjusting  the  acceleration  along  the 
desired  trajectories.  The  exponential  convergence  of  the  TCPF 
errors  is  guaranteed  and  demonstrated  using  Lyapunov  theory. 
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Appendix 

A.  Outline  of  the  proof  of  Lemma  1 

To  prove  the  exponential  convergence  of  the  TCPF  error  vector 

defined  in  (30),  first  note  that  the  following  system 

f(t)  =  -Lfit) 

is  GUES  [24],  with  L  satisfying  the  PE  assumption  in  (19). 


Furthermore,  choosing  the  following  transformation  operator 
X(t)  =  b£(t)  +  Qz{t) 

the  dynamic  of  the  TC  error  can  be  written  as 

X  =  -f  Lx  +  f  QLz  -  Qa{ex ,  ev) 
z  =  -( bl  -  \L)z  -  %LQrx  ~  a(ex,  e„) . 

Therefore,  leveraging  the  approach  in  [11]  for  Vpf  by  adding  two 
extra  terms  representing  the  TC  problem  (Vrc).  the  function 

V  =  —  |  |ea;|  |2  +  7p||e„||2  +  ^(.R)  +  ci(ej  ex)  + 
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i  T  t~)  |  1 1  1 1 2 

+  X  RcX+2  11*11  > 

V - v - ' 

vTc 

where  kx,  m,  ci  were  introduced  in  Section  II  and  Lemma  1,  and  Pc 
is  discussed  in  details  in  [25,  Theorem  4.12],  can  be  chosen  as  a  new 


Fig.  6:  UAV^:  PF  errors  ||ex|| ,  ||et,||  and  ||e^||  converge  to  zero 


Lyapunov  candidate  function.  Then,  following  the  same  arguments 
used  in  [24,  Lemma  2]  and  [11],  the  following  bound  holds: 

V  =Vpf  +  Vtc 

<  -  — -(1  -  c2)||ex||2  -  (fc„(l  -  c2)  -  ci)||e„||2+ 
m 

—  1“  +  -^(1  +  c2)  I \eA  llle"ll  + 

BicUt  ^41) 

+  (feCsmaxi  +  B)  \  \  \  \  \  \  G-v  \  |  H - 1 1  eR  |  1 1 1  ex  \  |  + 

+  ( kxbi  +  Ci  62)  1 1  1 1 1  gx  1 1  +  (ci6i  +  m62)|M|||e*,||  + 

-  csllxll2  -  (b~  n)\\z\\2  +n  ^  +  1  j  HxlllMI  • 

Finally,  it  can  be  proven  that  there  exist  kx,  ku,  k^,  ci,  a  and  b  such 
that 

V  <  -XV  (42) 

with  domain  of  attraction  defined  in  (34),  and  rate  of  convergence  A 
defined  in  (31).  therefore  leading  to  the  following: 

V{t)  <  V (0)e-At . 

Thus,  the  result  of  Lemma  1  immediately  follows. 

B.  Outline  of  the  proof  of  Lemma  2 

Start  by  considering  the  Lyapunov  function  in  (40).  Following 
the  same  outline  described  in  Appendix  A,  and  after  some  algebraic 
manipulations  (the  reader  is  referred  to  [13,  Appendix  C])  we  get: 


Recalling  the  result  in  (42),  and  following  a  proof  in  [25,  Lemma 
9.2],  leads  to 

V<-(X-d)V-e(^\\ex\\2  +  ^\\ev\\2  +  J^\\e/i\\2  + 
+ci(exex)  +\TPcX+  tI!2H2J  + 

+  \\eA  \  +  +  9^llej|ll  i 

where  0  <  9  <  X. 

Therefore,  after  straightforward  computations,  we  can  show  that 
outside  the  bounded  set 

rv  *  f  r  T  T  T  T  T  iT  . 

Qd  =  {x=[ex,ev  ,eA,X  ,  z  \  s.t. 

2ci5f  ,,  „  .  2(5/ 
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,  |  F«||  < 
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|e«||  <  2  $ 


the  following  bound  holds: 

V  <  -(A  -0)V. 


Finally,  letting  jp,  'yq,’yr  and  7 /  satisfy  the  bounds  in  (36)  and  (37) 
implies  that  f Id  C  f }c,  thus  proving  Lemma  2. 
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